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f^jj (57) Abstract: A vibrating structure gyroscope having a vibrating structure (3) primary drive means (4) and secondary drive means 
(7) and primary pick-off means (2) and secondary pick-off means (6) is provided with a control system. The control system includes 
a primary closed control loop (1) for controllably varying the drive signal applied to the primary drive means (4), a secondary closed 
control loop (5) for controllably varying the drive signal applied to the secondary drive means (7) in order to maintain a null value of 

fmm^ the secondary pick-off means (6) and means (30) for actively adjusting the scalefactor in the primary and secondary closed control 
loops (1, 5). The means (30) includes means (34) for dividing a rate response signal from the loop (5) by a signal indicative of the 
amplitude of the primary mode vibration. The output form the means (34) is filtered to provide an applied rate output A variable 
scalefactor loop (3) uses the output from the means (34) actively to adjust a reference voltage set level of loop (1) to adjust the in 
loop scalefactor of the system. 
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CONTOOL SVST1SM FOR A VIBRATING STRUCTURE GVROSCOPE 

vibrating structure gyroscope. ™cro-machined 
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F c are developed which couple energy into the secondary mode, whose radial anti- 
nodes are aligned along axes S f as shown in Figure lb. The magnitude of the 
force is given by: 

F c = 2mvQ app (1 ) 

where m is the modal mass, v is the effective velocity and Q a pp is the 
applied rotation rate. The primary mode vibration amplitude typically is maintained 
at a fixed level. This also maintains the velocity, v, at a fixed level and hence 
ensures that the developed Coriolis forces are directly proportional to the rotation 
rate, Q apP . The amplitude of secondary mode motion induced by these Coriolis 
forces may conventionally be enhanced by accurately matching the resonant 
frequencies of the primary and secondary modes. The motion is then amplified by 
the Q (measure of the relation between stored energy and the rate of dissipation of 
energy) of the secondary mode giving enhanced vibrating structure gyroscope 
sensitivity. When operating in this open loop mode the sensitivity (scalefactor) of 
the gyroscope will be dependent on the Q of the secondary mode which may vary 
significantly over the operating temperature range. This dependence may be 
eliminated by operating the gyroscope in a force feedback (closed loop) mode. In 
this mode the induced secondary mode motion is actively nulled with the applied 
force being directly proportional to the rotation rate. 

A typical conventional closed loop control system for a vibrating structure 
gyroscope is shown schematically in Figure 2 of the accompanying drawings. This 
conventional control system basically consists of two independent loops namely a 
primary loop 1 between a primary pick-off means 2 which acts as a motion 
detector output from the vibrating planar ring structure 3 and a primary drive 
means 4 which acts as a forcing input creating vibration in the structure 3. A 
secondary loop 5 is provided between a secondary pick-off means 6 and a 
secondary drive means 7. 

The output signal 8 from the primary pick-off means 2 is amplified by an 
amplifier 9 and demodulated by demodulators 10 and 1 T. The demodulated signal 
from the demodulator 10 is passed first to a phase locked loop 12 which compares 
the relative phases of the primary pick-off and primary drive signals at the means 2 
and 4 and adjusts the frequency of a voltage control oscillator 13 to maintain a 90° 
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For this mode of operation the rate output £2 0ut , is given by: 

£2out ^kSDCreaQg^gsd (2) 

V Q w 

where V D is the fixed primary mode amplitude reference voltage set level, 
w is the primary mode resonance frequency, k is a constant including the modal 
mass and modal coupling coefficient, g ppo is the primary mode pick-off gain and g sd 
is the secondary mode driver gain. 

For a gyroscope operating in this conventional closed loop mode, the 
minimum detectable rotation rate that can be resolved is determined by the 
sensitivity of the secondary mode pick-off means 6. This is "determined by the 
electronic noise of the secondary pick-off amplifier 19. For a fixed pick-off gain, 
the only way to enhance the resolution of the vibrating structure gyroscope is to 
increase the secondary mode motion generated by a given applied rate, that is to 
increase the in loop scalefactor. This may be achieved by increasing the drive 
level of the primary mode to give a larger amplitude of motion, that is to increase 
the primary mode amplitude set level V 0 . In practice there will be a limit to the 
maximum displacement for any given vibrating structure gyroscope design which 
limit may be set by a number of factors which include the available drive force, the 
fracture limit of the vibrating structure and non-linearities in the pick-off and drive 
means which conventionally are inductive, capacitive or piezo electric transducers. 

The maximum applied rate that the vibrating structure gyroscope can 
measure is limited by the ability of the secondary drive means 7 to maintain a null 
in the secondary mode motion. The secondary drive means 7 applies a force to 
null the induced Corioiis force. For rotation rates above a certain level the 
magnitude of the Corioiis force is such that secondary drive can no longer apply 
sufficient force to null the motion causing the rate output to saturate. For typical 
conventional vibrating structure gyroscopes this saturation level corresponds to 
applied rotation rates of less than a few hundred degrees per second. For a given 
secondary drive means gain it is possible to increase the maximum measurable 
applied rate. This is achieved by reducing the primary mode amplitude which 
reduces the magnitude of the induced Corioiis force for a given rotation rate. 
However this solution will degrade the signal to noise performance of the vibrating 
structure gyroscope thus reducing the resolution undesirably. 
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There is thus a need for an improved control system for a vibrating structure 
gyroscope which is capable of measuring greater rotation rates whilst maintaining 
high resolution. 

According to one aspect of the present invention there is provided a control 
system for a vibrating structure gyroscope having a vibrating structure, primary 
drive means and secondary drive means for putting and maintaining the vibrating 
structure in primary mode vibratory resonance, and primary pick-off means and 
secondary pick-off means for detecting vibration of the vibrating structure, which 
system includes a primary closed control loop for controllabiy varying, the drive 
signal applied to the primary drive means, a secondary closed control loop for 
controllabiy varying the drive s}gnal applied to the secondary drive means in order 
to maintain a null value at the secondary pick-off means, and means for actively 
adjusting the scalefactor in the primary and secondary closed control loops, which 
scalefactor active adjustment means includes means for dividing a rate response 
signal from the secondary control loop by a signal indicative of the amplitude of the 
primary mode vibration, means for filtering an output signal from the dividing 
means to provide an output indicative of the applied rate, and a variable 
scalefactor loop for receiving the output signal from the dividing means and using 
it actively to adjust a reference voltage set level of the primary closed control loop 
and thereby dynamically adjust the in loop scalefactor of the control system. 

Preferably the scalefactor active adjustment means includes means for 
reducing the primary mode vibration amplitude for applied rotation rates above a 
selected absolute threshold rate value. 

Conveniently the absolute threshold rate value selected is set at a value 
less than the rate output limit of the secondary closed control loop. 

Advantageously the primary closed control loop includes means for 
demodulating the signal received from the primary pick-off means, a phase locked 
loop for comparing the relative phases of the primary pick-off and primary drive 
signals, a voltage controlled oscillator the frequency of which is adjusted by the 
phase locked loop to maintain a 90° phase, shift between- the signals supplied to 
the primary drive means and - the motion of the vibrating structure, an automatic 
gain control loop for comparing the demodulated signal received from the primary 
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pick-off means to a fixed reference voltage level, and a modulator for remodulating 
the output signal received from the automatic gain control loop at the frequency 
supplied by the voltage controlled oscillation to provide the controllably varied 
drive signal supplied to the primary drive means. 

Preferably the secondary closed control loop includes means for 
demodulating and splitting the signal received from the secondary pick-off means 
into the real component and the quadrature component of a rate induced motion of 
the vibrating structure, loop filtering means for separately filtering the real and 
quadrature components, and means for remodulating and summing the filtered 
signal components for application to the secondary drive means.; 

Conveniently the variable scalefactor loop is connected between the 
demodulated output from the real component loop filtering means of the secondary 
closed control loop and the demodulated signal from the primary pick-off means. 

Advantageously the variable scalefactor loop includes means for dividing 
the modulus of the input signal applied to the variable scalefactor loop into a fixed 
voltage reference level with the output limited to values less than or equal to one, 
and means for filtering the output and for using the filtered output for scaling the 
zero rate voltage value of the fixed reference voltage level of the automatic gain 
control loop of the primary closed control loop. 

Preferably the control system includes means located between the 
secondary closed control loop and the variable scalefactor loop to divide the 
demodulated output from the real component loop filtering means of the secondary 
closed control loop by the demodulated signal from the primary closed control loop 
to provide an output signal proportional to the applied rate, which output signal 
forms the input to the variable scalefactor loop. 

Alternatively the control system includes means located between the 
secondary closed control loop and the variable scaliefactor loop to divide the 
demodulated output from the real component loop filtering means of the secondary 
closed control loop by the reference voltage level forming the output from the 
variable scalefactor loop, to provide an output signal proportional to the applied 
rate, whicfr output signal forms the input to the variable scalefactor loop. 
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Conveniently the control system includes means for taking off part of the 
output signal forming the input to the variable scalefactor loop, scaling it and 
filtering it to provide an output signal indicative of the rate applied to the 
gyroscope. 

Advantageously the control system is used with a vibrating structure 
gyroscope having a vibrating structure made from silicon. 

For a better understanding of the present invention and to show how the 
same may be carried into effect, reference will now be made, by way of example, 
to the accompanying drawings, in which: 

Figure 1a shows diagrammatically for a vibrating structure gyroscope not 
according to the present invention a Cos20 vibration mode which is excited as the 
primary mode, 

Figure 1b shows schematically a Sin2B vibration mode excited when the 
vibrating structure gyroscope, not according to the present invention, is rotated 
around an axis normal to the plane of the vibrating structure so that Coriolis forces 
are developed which couple energy into the secondary mode, 

Figure 2 is a schematic block diagram of a conventional control system not 
according to the present invention for a vibrating structure gyroscope, 

Figure 3 is a generalised block diagram of a control system according to a 
first embodiment of the present invention, 

Figure 4 is a generalised block diagram of a control system according to a 
second embodiment of the present invention, and 

Figure 5 is a schematic block diagram showing the functionality of a 
variable scalefactor loop utilised in a control system of the present invention. 

A control system according to a first embodiment of the present invention 
for a vibrating structure gyroscope is shown in Figure 3 of the accompanying 
drawings. In this embodiment of the invention the primary loop 1 and secondary 
loop 2 are very similar to the primary loop 1: and secondary loop 2 of the 
conventional control system shown in Figure 2 and like components common to 
both Figures 2 and 3 will be given like reference numerate and not commented on 
further in any detail. Additionally although the control system of the present 
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invention is shown and described as applied to a vibrating structure 3 made from 
silicon it can also be applied to the vibrating structure 3 made from metal or piezo 
ceramic material. 

Adjusting the scalefactor as previously described has the problem, that 
once set, the scalefactor cannot subsequently be varied. In order to extend the 
rate range of the vibrating structure gyroscope without compromising the lower 
rate performance it is necessary actively to adjust the in-loop scalefactor at higher 
applied rates. A control system according to the present invention includes means 
30 in the primary and secondary closed control loops 1 , 5 to enable the gyroscope 
to measure high applied rotation rates whilst maintaining optimum resolution at low 
rotation rates. To this end the scalefactor active adjustment means 30 includes 
means for reducing the primary mode vibration amplitude for applied rotation rates 
above a selected absolute threshold rate value. The applied rates are positive or 
negative. The absolute threshold rate value is conveniently set at a value 
slightly below the normal output limit of the secondary drive means 7. 

For applied rates below the threshold value the primary mode amplitude is 
maintained at a constant value. The secondary mode motion induced by the 
Coriolis forces will be directly proportional to the applied rate and is nulled in a 
conventional manner using the secondary drive means 7. As the applied rate 
exceeds the threshold value the primary mode amplitude is reduced therefore 
decreasing the secondary loop scalefactor. In this rate range the secondary drive 
is maintained around a constant, maximum, level and the- primary mode amplitude 
varies inversely proportional to the applied rate. This is achieved by adjusting the 
primary mode amplitude reference voltage set level V A gc in the following manner 

Vagc°c 1/Qapp (3) 

To obtain a linear rate output over the entire operating range it is necessary 
to use the secondary drive level normalised using the primary mode amplitude. 
The rate output Q 0 ut is given by: 

Qout^k SD(real)g P pog S D (4) 

Vppo w 

where Vppd is the primary pick-off signal indicative of the primary mode 
amplitude. 
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To carry this into effect and provide an extended rate range capability as 
shown in Figure 3 the scalefactor adjustment means- 30 are provided connected 
between the secondary closed loop 5 and the primary closed control loop 1 The 
means 30 includes means 34 located between the secondary closed control loop 5 
and the variable scalefactor loop 31 for dividing the demodulated output 32 from 
the real component loop filtering means 23 of the secondary dosed control loop 5 
by the demodulated signal component 33 from the primary closed control loop 1 to 
prov.de an output signal 35 proportional to the applied rate. The output 35 forms 
the input to a variable scalefactor loop 31 (fonning part of the means 30, and is 
used to scale the voltage reference level 15 supplied to the automatic gain control 
loop 14 of the primary pick-off signal 33. This output signal 35 is also scaled and 
filtered by means 36 to provide a final output signal Q OUT which is indicative of the 
rate applied to the gyroscope. 

Alternatively as shown in Figure 4 of the accompanying drawings, the 
means 30 for actively adjusting the scalefactor may be implemented using the 
input voltage 15 instead of the demodulated other signal component 33 of the 
primary closed control loop 1 without changing the basic functionality of the control 
system. Thus as shown in Figure 4 the means 34 which is located between the 
secondary control closed loop 5 and the variable scalefactor loop 31 to divide the 
demodulated output 32 from the real component loop filtering means 23 of the 
secondary closed control loop 5 by V AGC the reference voltage level 15 forming the 
output from the variable scalefactor loop 31 provides an output direct current 
signal 35 proportional to the applied rate, which output signal forms the input to the 
vanable scalefactor loop 31. The signal 35 is also scaled and filtered as at 36 to 
provide the final output signal 37 (Q out ) which is indicative of the rate applied to the 
gyroscope. 

The functionality of the variable scalefactor loop 31 is shown schematically 
«n Figure 5. The modulus of the input signal 35 (Q^ applied to the variable 
scalefactor loop 31 is divided at 38 into a fixed voltage, reference level indicative of 
Qth withthe output value X limited. to less than orequal to 1 at 39. This, reference 
level sets the threshold rate value and effectively limits the maximum real 
dnve amplitudewhich may be applied to the secondary drive means 7. The output 
X is then used at 40 to scale V* the zero rate value of the automatic gain control 
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reference voltage level Vagc (input 15). The output 4 1 from 40 is filtered in a loop 
filter 42 to provide the required dynamic response prior to application to the 
automatic gain control loop 14. 

The variable scalefactor loop filtering has a critical role in determining the 
dynamic performance of the control system. As the bandwidth of the variable 
scalefactor loop 31 typically is low compared to that of the secondary (real) control 
loop 5, the primary amplitude will respond relatively slowly to rapid changes in the 
applied rate in the region above the threshold value Qjh this means that the null at 
the secondary pick-off means 6 is predominantly maintained by adjusting the 
secondary drive means 7 under the control of the secondary control loop 5. For 
rapid increases in Q A pp this will cause the instantaneous secondary drive levels to 
exceed the steady state condition for the equivalent applied rates. This will require 
that fljh be set to provide sufficient overdrive range to prevent the secondary drive 
"overshooting" and exceeding the output limit under these transient conditions. 
This is detrimental to the performance of this system as it restricts the usable 
dynamic range of the secondary control loop 5 under normal conditions, that is 
where there are no rapid changes in Qapp. Extending the bandwidth of the 
variable scalefactor loop 31 will limit the extent of the secondary drive overshoot 
by enabling the automatic gain control loop 14 to respond more rapidly. Extending 
the band width will, however, degrade the noise performance of the system. 

The detailed loop filter design of the control system according to the present 
invention is dependant upon the precise performance requirements. The usable 
rate range of the vibrating structure gyroscope to which It is applied, and which 
preferably has a vibrating structure made from silicon may be extended from the 
typical 100° per second to in excess of 10,000° per second. This is achieved 
without degradation in performance at the lower applied rates. There will, 
however, be some degradation of the noise performance as the rate is increased 
above, the threshold level due to the reduced amplitude of primary motion. 



BNSDOCID: <WO 0177620A1J_> 



WO 01/77620 




PCT/GB01/01381 



CLAIMS 

A control system for vibrating structure gyroscope having a vibrating 
structure, primary drive means and secondary drive means for putting and 
maintaining the vibrating structure in primary mode vibratory resonance, 
and primary pick-off means and secondary pick-off means for detecting 
vibration of the vibrating structure, which system includes a primary closed 
control loop forcontroflably varying the drive signal applied to the primary 
drive means, a secondary dosed control loop for controllably varying the 
drive signal applied to the secondary drive means in orderto maintain a null 
value at the secondary pick-off means, and means for actively adjusting the 
scalefactor in the primary and secondary closed control loops which 
scalefactor active adjustment means includes means for dividing a rate 
response signal from the secondary control loop by a signal indicative of the 
amplitude of the primary mode vibration, means for filtering an output signal 
from the dividing means to provide an output indicative of the applied rate, 
and a variable scalefactor loop for receiving the output signal from the 
dividing means and using it actively to adjust a reference voltage set level 
of the primary closed control loop and thereby dynamically adjust the in 
loop scalefactor of the control system. 

A control systems according to Claim 1, wherein the scalefactor active 
adjustment means includes means for reducing the primary mode vibration 
amplitude for applied rotation rates above a selected absolute threshold 
rate value. 

A control system according to Claim 2, wherein the absolute threshold rate 
value selected is set at a value less than the rate output limit of the 
secondary closed control loop. 

A control system according to any one of Claims 1 to 3, wherein the primary 
closed control loop includes means for demodulating the signal received 
from the primary pick-off means, a phase locked, loop for comparing the 
relative phases of the primary pick-off and primary drive, signals, a. voltage 
controlled oscillator the frequency of which is adjusted by the phase locked 
loop to maintain a 90° phase shift between the signal applied to the primary 
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drive means and the motion of the vibrating structure, an automatic gain 
control loop for comparing the demodulated signal received from the 
primary pick-off means to a fixed reference voltage level, and a modulator 
for remodulating the output signal received from the automatic gain control 
loop at the frequency supplied by the voltage controlled oscillator to provide 
the controllably varied drive signals applied to the primary drive means. 

5. A control system according to any one of Claims 1 to 4, wherein the 
secondary closed control loop includes means for demodulating and 
splitting the signal received from the secondary pick-off means into the real 
component and of the quadrature component of rate induced motion of the 
vibrating structure, loop filtering means for separately filtering the real and 
quadrature components, and means for remodulating and summing the 
filtered signal components for application to the secondary drive means. 

6. A control system according to Claim 4 and Claim 5, wherein the variable 
scalefactor loop is connected between a demodulated output from the real 
component loop filtering means of the secondary closed control loop and 
the demodulated signal from the primary pick-off means. 

7. A control system according to Claim 6, wherein the variable scalefactor loop 
includes means for dividing the modulus of the input signal applied to the 
variable scalefactor loop into a fixed voltage reference level with the output 
limited to values less than or equal to one, and means for filtering the output 
and for using the output for scaling the zero rate voltage value of the fixed 
reference voltage level to the automatic gain control loop of the primary 
closed control loop. 

8. A control system according to Claim 7, including means located between 
the secondary closed control loop and the variable scalefactor loop to divide 
the demodulated output from the real component loop filtering means of the 
secondary closed control loop by the demodulated signal from the primary 
closed control loop to provide an output signal proportional to the applied 
rate, which output signal forms the inputto the variable scalefactor loop. 

9. A control system according to Claim 7, including means located between 
the secondary closed control loop and the variable scalefactor loop to divide 
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the demodulated output from the real component loop filtering means of the 
secondary closed control loop by the reference voltage level forming the 
output from the variable scalefactor loop to provide an output signal 
proportional to the applied rate, which output signal forms: the input to the 
variable scalefactor loop. 

10. A control system according to Claim 8 or Claim 9, including means for 
taking off part of the output signal forming the input to the variable 
scalefactor loop, scaling it and filtering it to provide an output signal 
indicative of the rate applied to the gyroscope. 

11. A control system according to any one of Claims 1 to 1 0, when used with a 
vibrating structure gyroscope having a vibrating structure made from silicon. 

12. A control system for a vibrating structure gyroscope, substantially as herein 
before described and as illustrated in Figure 3 or Figure 4 as modified or 
not by* Figure 1a, 1b or 5 of the accompanying drawings. 
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Fig.lA. 




Fig. 1b. 




BNSDOCID: <WO 0177620A1_I_> 



WO 01/77620 €t 



m 



PCT/GB01/01381 



3/5 



CO 
LL 




in 

, CM 




CO 
CM 



CM 
CO 



evil 




COI 
evil 


CVJI 






BNSDOCID: <WO 0177620A1J_> 



WO 01/77620 



PCT/GB01/01381 



5/5 



O 



in a 



31 




INTERNATIONAL SEARCH REPORT 



h " lional Application No 

rn/GB 01/01381 



A. CLASSIFICATION OF SUBJECT MATTER 

IPC 7 G01C19/56 



According to International Patent Classification (IPC) or to both nallona) classification and IPC 



B. FIELDS SEARCHED 



Minimum documentation searched (classification system followed by classification symbols) 

IPC 7 G01C 



Documentation searched other than minimum documentation to the extent that such documents are included in the fields searched 



Electronic data base consulted during the international search (name of data base and, where practical, search terms used) 

EPO-Internal, PAJ, WPI Data 



C. DOCUMENTS CONSIDERED TO BE RELEVANT 



Category ° Citation of document, with indication, where appropriate, of the relevant passages 



Relevant to claim No. 



WO 99 14557 A (BRITISH AEROSPACE ;T0WNSEND 
KEVIN (GB)) 25 March 1999 (1999-03-25) 
page 1, last paragraph -page 2, paragraph 
1; figure 1 

WO 99 02942 A (BRITISH AEROSPACE ;FELL 
CHRISTOPHER PAUL (GB); TOWNSEND KEVIN 
(GB)) 21 January 1999 (1999-01-21) 
page 2, last paragraph -page 3, paragraph 
2; figures 2,3 



1-11 



1-11 



□ 



Further documents are listed In the continuation of box C. 



Patent famBy members are listed In annex. 



• Special categories of cited documents : 

•A* document defining the general state of the art which is not 

considered to be of particular relevance 
"E" earlier document but published on or after the international 

fling date 

•L" document which may throw doubts on priority claim(s) or 
which is cfted to establish the pubRcafion dale of another 
citation or other special reason (as specffied) 

"O" document referring to an oral disclosure, use, exhibfiion or 
other means 

■P" document published prior to the international filing date but^ 
later than the priority dale claimed 



T" later document published after the international filing date 
or priority dale and not in conflict with the application but 
cfted to understand the principle or theory underlying the 
invention 

*X" document of particular relevance; the ciaimed invention 
cannot be considered novel or cannot be considered to 
Involve an Inventive step when the document is taken alone 

'Y 1 document of particular relevance; the claimed invention 

cannot be considered to involve an Inventive step when the 
document Is combined with one or more other such docu- 
ments, such combination being obvious to a person skilled 
In the art. 

document member of the same patent family 



Date of the actual completion of the international search 



19 June 2001 



Date of mailing of the international search report 



28/06/2001 



Name and mailing address of the (SA 

European Patent Office, P.B. 5818 Patentlaan 2 
NL-2280HVRqswijk 
Tel. (+31-70) 340-2040, Tx. 31 651 epo nl f 
Fax: (+31-70) 340-3016 



Authorized officer 



Springer, 0 



Form PCT/tSA/210 (second sheet) (Juiy 1932) 



BNSDOCID: <WO 0177620A1J_> 



INTERNATIONAL SEARCH REPORT 



lij ational Application No 

Ki/GB 01/01381 



Patent document 
cited in search report 



Publication 
date 



Patent family 
member(s) 



Publication 
date 



WO 9914557 



25-03-1999 



GB 
AU 
AU 
EP 
JP 



2329471 
729551 
9172498 
1015849 
2000513452 



NO 20001418 A 



WO 9902942 



21-01-1999 



GB 
AU 
EP 



2327265 A 
8348398 A 
1012538 A 



24-03-1999 
01-02-2001 
05-04-1999 w? 
05-07-2000" 
10-10-2000 * 
17-03-2000 



20-0141999 
08-02-1999 
28-06-20T&0* 



V 



Form PCT/lSA/210 (patent family annex) (July 1992) 
BNSDOCID: <WO 0 177620 A 1_L> 



THIS PAGE BIANK^ 0 



